Full-Body Motion Planning And Control For The Car Egress Task Of The Drc